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Abstract We extend our study of Motion Planning via Manifold Samples 
(MMS), a general algorithmic framework that combines geometric methods 
for the exact and complete analysis of low-dimensional configuration spaces 
with sampling-based approaches that are appropriate for higher dimensions. 
The framework explores the configuration space by taking samples that are 
entire low- dimensional manifolds of the configuration space capturing its con- 
nectivity much better than isolated point samples. The contributions of this 
paper are as follows: (i) We present a recursive application of MMS in a six- 
dimensional configuration space, enabling the coordination of two polygonal 
robots translating and rotating amidst polygonal obstacles. In the adduced 
experiments for the more demanding test cases MMS clearly outperforms 
PRM, with over 20-fold speedup in a coordination-tight setting, (ii) A prob- 
abilistic completeness proof for the most prevalent case, namely MMS with 
samples that are affine subspaces. (iii) A closer examination of the test cases 
reveals that MMS has, in comparison to standard sampling-based algorithms, 
a significant advantage in scenarios containing high- dimensional narrow pas- 
sages. This provokes a novel characterization of narrow passages which at- 
tempts to capture their dimensionality, an attribute that had been (to a large 
extent) unattended in previous definitions. 
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1 Introduction 

Configuration spaces, or C-spaces, are fundamental tools for studying a large 
variety of systems. A point in a d-dimcnsional C-space describes one state 
(or configuration) of a system governed by d parameters. C-spaces appear 
in diverse domains such as graphical animation, surgical planning, compu- 
tational biology and computer games. For a general overview of the subject 
and its applications see [8, 22, 24]. The most typical and prevalent example 
are C-spaces describing mobile systems ( "robots" ) with d degrees of freedom 
(dofs) moving in some workspace amongst obstacles. As every point in the 
configuration space C corresponds to a free or forbidden pose of the robot, C 
decomposes into disjoint sets Cf rcc and Cf or b, respectively. Thus, the motion- 
planning problem is commonly reduced to the problem of finding a path that 
is fully contained within Cf ree - 

1.1 Background 

C-spaces haven been intensively studied for over three decades. Fundamen- 
tally, two major approaches exist: 

(i) Analytic solutions: The theoretical foundations, such as the introduc- 
tion of C-spaces [26] and the understanding that constructing a C-space is 
computationally hard with respect to the number of dofs [28], were already 
laid in the late 1970's and early 1980's in the context of motion planing. 
Exact analytic solutions to the general motion planning problem as well as 
for various low-dimensional instances have been proposed in [3, 6, 7, 31] and 
[1, 2, 14, 26, 30], respectively. For a survey of related approaches see [32]. 
However, only recent advances in applied aspects of computational geometry 
made robust implementations for important building blocks available. For 
instance, Minkowski sums, which allow the representation of the C-space of a 
translating robot, have robust and exact two- and three-dimensional imple- 
mentations [12, 13, 35]. Likewise, implementations of planar arrangements 2 
for curves [34, C.30], could be used as essential components in [31]. 

(ii) Sampling-based approaches: Sampling-based approaches, such as 
Probabilistic Roadmaps (PRM) [19], Expansive Space Trees (EST) [16] and 
Rapidly-exploring Random Trees (RRT) [23] , as well as their many variants, 
aim to capture the connectivity of Cf rco in a graph data structure, via random 
sampling of configurations. For a general survey on the field see [8, 24]. As op- 
posed to analytic solutions these approaches are also applicable to problems 
with a large number of dof . Importantly, the PRM and RRT algorithms were 
shown to be probabilistically complete [17, 20, 21], that is, they are guaran- 
teed to find a valid solution, if one exists. However, the required running time 
for finding such a solution cannot be computed for new queries at run-time. 
This is especially problematic as these algorithms suffer from high sensitivity 



2 A subdivision of the plane into zero-dimensional, one-dimensional and two-dimensional 
cells, called vertices, edges and faces, respectively induced by the curves. 
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to the so-called "narrow passage" problem, e.g., where the robot is required 
to move in environments cluttered with obstacles, having low clearance. 

Though there are also some hybrid approaches [10, 15, 25, 36] it is apparent 
that the arsenal of currently available motion-planning algorithms lacks a 
general scheme applicable to high-dimensional problems with little or low 
sensitivity to narrow passages. In [29] we introduced a framework for Motion 
Planning via Manifold Samples (MMS), which should also be considered as 
a hybrid approach. In a setting considering a three-dimensional C-space it 
was capable of achieving twenty-fold (and more) speedup factor in running 
time when compared to the PRM algorithm when used for planning paths 
within narrow passages. We believe that the speedup presented in [29] does 
not present a mere algorithmic advantage for a specific implemented instance 
but a fundamental advantage of the framework when solving scenarios with 
narrow passages. 

This study attempts to continue developing the MMS framework as a 
tool to overcome the gap mentioned in existing motion-planning algorithms. 
We briefly present the scheme and continue to a preliminary discussion on 
applying MMS in high-dimensional C-spaces, which motivates this paper. 

1.2 Motion Planning via Manifold Samples 

The framework is presented as a means to explore the entire C-space, or, 
in motion-planning terminology as a multi-query planner, consisting of a 
preprocessing stage and a query stage. The preprocessing stage constructs 
the connectivity graph Q of C, a data structure that captures the connectivity 
of C using entire low- dimensional manifolds as samples. The manifolds are 
decomposed into cells in Cf roc and Cf or b in an analytic manner; we call a 
cell of the decomposed manifold that lies in Cf ree a free space cell (FSC). 
The FSCs serve as nodes in Q. Two nodes are connected by an edge if their 
corresponding FSCs intersect. See Fig. 1 for an illustration. 

Once Q has been constructed it can be queried for paths between two con- 
figurations q s , q t G Cf rC c in the following manner: A manifold that contains q s 
in one of its FSCs is generated and decomposed (similarly for q t ). These 
FSCs and their appropriate edges are added to Q. We compute a path 7 in Q 
between the FSCs that contain q s and qt- If such a path is found in Q, it can 
be (rather straightforwardly) transformed into a continuous path in Cf ree by 
planning a path within each FSC in 7. 

1.3 MMS in Higher Dimensions 

The successful application of MMS in [29] to a three-dimensional C-space can 
be misleading when we come to apply it to higher dimensions. The heart of 
the scheme is the choice of manifolds from which we sample. Informally, for 
the scheme to work we must require that the used set of manifolds M. fulfills 
the following conditions. 

CI The manifolds in M. cover the C-space. 
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Fig. 1: Three-dimensional C-spaces: The left side illustrates two families of man- 
ifolds where the decomposed cells are darkly shaded. The right side illustrates 
their intersection that induces the graph Q. Figure taken from [29]. 

C2 A pair of surfaces chosen uniformly and independently 3 at random 
from M. intersect with significant probability. 

C3 Manifolds need to be of very low dimension as MMS requires an ana- 
lytic description of the C-space when restricted to a manifold. Otherwise 
the machinery for a construction of this description is not readily available. 

For MMS to work in C-spaces of dimension d, Condition C2 has a pre- 
requisite that the sum of dimensions of a pair of manifolds chosen uniformly 
and independently at random from M. is at least d with significant proba- 
bility. This means in particular that M. will consist of manifolds of dimen- 
sion 4 |~|] . With this prerequisite in mind, there is already what to gain from 
using our existing and strong machinery for analyzing two-dimensional man- 
ifolds [4, 5, 11], while fulfilling the conditions above: We can solve motion- 
planning problems with four degrees of freedom, at the strength level that 
MMS offers, which is higher than that of standard sampling-based tools. 

However, we wish to advance to higher-dimensional C-spaces in which 
satisfying all the above conditions at once is in general impossible. We next 
discuss two possible relaxations of the conditions above that can lead to 
effective extensions of MMS to higher dimensions. 

Dependent choice of manifolds: If we insist on using only very low- 
dimensional manifolds even in higher-dimensional C-spaces, then to guaran- 
tee that pairs of manifolds intersect, we need to impose some dependence 
between the choices of manifolds, i.e., relaxing condition C2. A natural way 
to impose intersections between manifolds is to adapt the framework of tree- 

3 The requirement that the choices are independent stems from the way we prove com- 
pleteness of the method. It is not necessarily an essential component of the method itself. 

4 The precise statement is somewhat more involved and does not contribute much to 
the informal discussion here. Roughly, Ai should comprise manifolds of dimension ["^] or 
higher and possibly manifolds of their co-dimension. 
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based planners like RRT [23]. When we add a new manifold, we insist that it 
connects either directly or by a sequence of manifolds to the set of manifolds 
collected in the data structure (tree in the case of RRT) so far. 

Approximating manifolds of high dimension: As we do not have the 
machinery to exactly analyze C-spaces restricted to manifolds of dimension 
three or higher, we suggest to substitute exact decomposition of the manifolds 
as induced by the C-space by some approximation, i.e., relaxing condition C3. 
There are various ways to carefully approximate C-spaces. In the rest of the 
paper we take the approach of a recursive application of MMS. 

In Section 2 we demonstrate this recursive application for a specific prob- 
lem in a six-dimensional configuration space, namely the coordination of two 
planar polygonal robots translating and rotating admits polygonal obsta- 
cles. In the adduced experiments for the more demanding test cases MMS 
clearly outperforms PRM, with over 20-fold speedup in an especially tight 
setting. Section 3 provides the theoretical foundations for using MMS in a 
recursive fashion. In Section 4 we examine the significant advantage of MMS 
with respect to prevailing sampling-based approaches in scenarios containing 
high- dimensional narrow passages. This provokes a novel characterization of 
narrow passages which attempts to capture their dimensionality. We conclude 
with an outlook on further work in Section 5. 

2 The Case of Two Rigid Polygonal Robots 

We discuss the MMS framework applied to the case of coordinating the mo- 
tion of two polygonal robots R a and Rt translating and rotating in the 
plane amidst polygonal obstacles. Each robot is described by the position 
of its reference point r a ,ri, £ R 2 and the amount of counter-clockwise ro- 
tation 6 a , 9b with respect to an initial orientation. All placements of R a in 
the workspace W induce the three-dimensional space C a = R 2 x S 1 . Sim- 
ilarly for Rb. We describe the full system by the six-dimensional C-space 
C = C a x C b . 

2.1 Recursive Application of the MMS Framework 

We first assume (falsely) that we have the means to decompose three- 
dimensional manifolds. Under this assumption, the application of MMS is 
straightforward: The set M consists of two families. An element of the first 
family of manifolds is defined by fixing R b at free configurations b £ Cj ree 
while R a moves freely inducing the three-dimensional subspaces 5 C a x b. The 
second family is defined symmetrically by fixing R a . As subspace pairs of the 
form (a x C b , C a x b) intersect at the point (a, b), manifolds of the two families 
intersect allowing for connections in the connectivity graph Q. 



5 In this paper, when discussing subspaces, we should actually use the term affine subspaces 
or linear manifolds. We allow ourselves this (slight) inaccuracy for ease of reading. 
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(a) Horizontal slices (b) Vertical lines 

Fig. 2: Manifolds families and their FSCs. FSCs of horizontal slices are polygons 
while FSCs of vertical lines are intervals along the line. 

However, we do not have the tools to construct three-dimensional man- 
ifolds explicitly. Thus the principal idea is to construct approximations of 
these manifolds by another application of MMS. Since for a certain manifold 
one robot is fixed, we are left with a three-dimensional C-space in which the 
fixed robot is regarded as an obstacle. Essentially this is done by using the 
implementation presented in [29] but with a simpler set of manifolds (see also 
Fig. 2): (i) Horizontal slices - corresponding to a fixed orientation of the 
moving robot while it is free to translate (ii) Vertical lines - corresponding 
to a fixed location of the moving robot while it is free to rotate. 

This recursive application of MMS is not straightforward since it must be 
ensured that the approximations of the three-dimensional subspaces intersect. 
We overcome this difficulty by randomly sampling sets Q a and Ob of angles 
for the two robots. When constructing a subspace for moving robot R a , we 
construct a horizontal slice for each angle in a . When fixing robot R a , we 
sample its orientation from the set & a . Similarly for robot Rb- This way, pairs 
of approximated subspaces are bound to intersect. 

2.2 Implementation Details 

Horizontal slices: Let R m and Rf denote the moving and fixed robot, re- 
spectively. m denotes the set of angles that is sampled for R m . A horizontal 
plane for an angle 9 m g m is defined by the Minkowski sum of — Rg m with 
all obstacles and, in addition, with the fixed robot. 6 However, for each ap- 
proximation of a three-dimensional affine subspace of robot R m we are using 
the same set of angles, namely & m . Only the position of robot Rf changes. 
Therefore, for all 6 m £ m we precompute the Minkowski sum of robot 
—Rg m with all obstacles. In order to obtain a concrete slice we only add the 
Minkowski sum of —Re m with Rf by a simple overlay. 

Vertical lines: Fixing the reference point of R m to some location while it is 
free to rotate induces a vertical line in the three-dimensional C-space. Each 
vertex (or edge) of the robot in combination with each edge (or vertex) of 
an obstacle (or the fixed robot) gives rise to up to two critical angles on this 

6 denotes R m rotated by 9 m and reflected about the origin. 
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(a) Random polygons (b) Viking helmet (c) Pacman 

Fig. 3: Experimental scenarios 

line. These critical values mark a potential transition between Cf or b and Cf ree . 
Thus a vertical line is constructed by computing these critical angles and the 
FSCs are maximal free intervals along this line (for further details see the 
Appendix) 

2.3 Experimental Results 

We demonstrate the performance of our planner using three different scenar- 
ios. All scenarios consist of a workspace, obstacles, two robots and one query 
(source and target configurations). All reported tests were measured on a 
Dell 1440 with one 2.4GHz P8600 Intel Core 2 Duo CPU processor and 3GB 
of memory running with a Windows 7 32-bit OS. Preprocessing times pre- 
sented are times that yielded at least 80% (minimum of 5 runs) success rate 
in solving queries. The algorithm is implemented in C++ based on Cgal [34], 
which is used for the geometric primitives, and the BOOST graph library [33], 
which is used to represent the connectivity graph Q . 

Fig. 3 illustrates the scenarios where the obstacles are drawn in blue and 
the source and target configurations are drawn in green and red, respec- 
tively. We used an implementation of the PRM algorithm as provided by the 
OOPSMP package [27]. For fair comparison, we did not use cycles in the 
roadmap as cycles increase the preprocessing time significantly. We manually 
optimized the parameters of each planner over a concrete set. The param- 
eters for MMS are: ng - the number of sampled angles; rig - the number 
of vertical lines; n/ - the number of times some robot is fixed to a certain 
configuration while the three-dimensional C-space of the other is computed. 
The parameters used for the PRM are: k — the number of neighbors to which 
each milestone should be connected; %st - the percentage of time used to 
sample new milestones. The results are summarized in Tabic 1. 

The Random polygons scenario 7 is an easy scenario where little coordi- 
nation is required. Both planners require the same amount of time to solve 
this case. We see that even though our planner uses complex primitives, when 




A scenario provided as part of the OOPSMP distribution. 
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Table 1: Comparison With PRM 

using the right parameters, it can handle simple cases with no overhead when 
compared to the PRM algorithm. 

The Viking-helmet scenario consists of two narrow passages that each 
robot needs to pass through. Moreover, coordination is required for the two 
robots to exchange places in the lower chamber. We see that the running times 
of the MMS are favorable when compared to the PRM implementation. Note 
that although each robot is required to move along a narrow passage, the 
motion along this passage does not require coordination between the robots. 

The Pacman scenario, in which the two robots need to exchange places, 
requires coordination of the robots: they are required to move into a position 
where the C-shaped robot, or pacman, "swallows" the square robot, the pac- 
man is then required to rotate around the robot. Finally the two robots should 
move apart (see Fig. 5). We ran this scenario several times, progressively in- 
creasing the square robot size. This caused a "tightening" of the passages 
containing the desired path. Fig. 4 demonstrates the preprocessing time as 
a function of the tightness of the problem for both planners. A tightness of 
zero denotes the base scenario (Fig. 3c) while a tightness of one denotes the 
tightest solvable case. Our algorithm has less sensitivity to the tightness of 
the problem as opposed to the PRM algorithm. In the tightest experiment 
solved by the PRM, MMS runs 20 times faster. We ran the experiment on a 
tighter scenario but the PRM algorithm terminated after 5000 seconds due 
to lack of memory resources. We believe that behavior of the algorithms with 
respect to the tightness of the passage is a fundamental difference between 
the two algorithms and discuss its origin in Section 4. 





(a) The square robot moves into a po- 
sition where the pacman can engulf it 



(b) The pacman engulfs the square 
robot 



Fig. 5: Example of a path in the Pacman Scenario 
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3 Probabilistic Completeness of MMS 

It has been shown that PRM, using point samples, is probabilistically com- 
plete (see, e.g., [8, C.7]). At first glance it may seem that if the scheme is 
complete for point samples then it is evidently complete when these samples 
arc substituted with manifold samples: manifolds of dimension one or higher 
guarantee better coverage of the configuration space. However, there is a cru- 
cial difference between PRM and MMS when it comes to connectivity. The 
completeness proof for PRM relies, among others facts, on the fact that if 
the straight line segment in the configuration space connecting two nearby 
samples lies in the free space, then the nodes corresponding to these two con- 
figurations are connected by an edge in the roadmap graph. The connectivity 
in MMS is attained through intersections of manifolds, which may require a 
chain of subpaths on several distinct manifolds to connect two nearby free 
configurations. This is what makes the completeness proof for MMS non 
trivial and is expressed in Lemma 3.2 below. 

We present a probabilistic completeness proof for the MMS framework 
for the case where the configuration space C is the d-dimensional Euclidean 
space R d while MMS is taking samples from two perpendicular affine sub- 
spaces, the sum of whose dimension is d. Assuming Euclidean space does not 
impose a real restriction as long as the actual C-space can be embedded into 
a Euclidean space. Also in more complex cases such as periodic parameters 
this only requires some minor technical modifications. 

Let A and B denote such subspaces and let k and d — k be their dimen- 
sions, respectively. As C is decomposed into two perpendicular subspaces, 
a point p — (ai, . . . , afc, b±, . . . , bd-k) € C may be represented as the pair 
of points (a, b) from subspaces A and B. Under this assumption, the set of 
manifolds A4 consists of two families of (d — k) and fc-dimcnsional mani- 
folds M. B and M. A . Family M. A consists of all manifolds that are defined 
by fixing a point ao G A while the remaining d — k parameters are variable, 
M B is defined symmetrically. Two manifolds m(a) G M A and m(b) G M B 
always intersect in exactly one point, i.e., m(a) n m(b) = (a, b) G C. 
Let B^(p) — {q G C | dist(p,q) < r} define a ball in C of radius r centered 
at p G C, where dist denotes the Euclidean metric on C. Likewise, B B (b) 
and B A (a) denote (d — k) and fc-dimensional balls in B and A, respectively. 

Definition 1 (p-intersecting). For p > we term a manifold m(a) G 
M A p- inter seating for a point p G C if m(a) n B^(p) ^ 0, i.e., if a G B a (pa), 
where pa is the projection of p into A. Similarly for manifolds in B. 

A feasible path 7 is a continuous mapping from the interval [0, 1] into Cf ree - 
The image of a path is defined as Im(j) = {7(a) | a G [0, 1]}. We show that 
for any collision-free path 7 P>9 of clearance p > between two configura- 
tions p and q, the probability that MMS constructs a path from p to q with 
distance at most p from 7 Pi(? on the union of the sampled manifolds is pos- 
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Fig. 6: Two-dimensional sketch: balls and manifolds are presented as circles and 
lines, respectively, (a) Intersection of two p/\/2-intersecting manifolds, (b) Con- 
struction of a path as defined in Lemma 3.2. 

itive. Moreover, the probability of failing to find such a path by the MMS 
algorithm decreases exponentially with the number of samples. 

Lemma 3.1 For p e C and p > let m(a) € M A and m(b) £ M B be two 
manifolds that are pj 1 \2-intersecting. Their intersection point p' — (a.b) = 
m(a) C\m{b) is in B p (p). 

Proof. m(a) is pj %/2-intersecting for p. Hence, we know that the distance of a 
to pa is less than p/V%, the same holds for b and ps- Thus we can conclude 
(as demonstrated in Fig. 6a): 

dist(p,p') — y dist(pA, a) 2 + dist(pB, b) 2 < p. 

□ 

The following lemma shows that for any two points p and q, a manifold 
m(b) e M B that is close to both points enables a connection between two 
manifolds m(a p ), m{a q ) S M. A that are close to p and q, respectively. 

Lemma 3.2 Let p,q € C be two points such that dist(p, q) < p and 
let m(a p ),m(a q ) g Ai A be two p / y/2-intersecting manifolds for p and q 
respectively. Let m(b) G M. B be a manifold that is simultaneously p/^/2- 
intersecting for p and q and let p' = (a p ,pB) G B c p {p) and q' — (a q ,qB) € 
Bp(q) be the projection of p and q on m(a p ) and m(a q ), respectively. 

There exists apathj p r q/ between p' and q' such that 7m(7 P ' j(J ') C (B p (p)U 
Bp(q)) H (m(a p ) U m(b) U m(a q j), i.e. there is a path lying on the manifolds 
within the union of the balls. 

Proof. Let p" = m(a p ) n m(b) — (a p ,b) and q" — m(a q ) n m(b) = {a q ,b) 
denote the intersection point of m(a p ) and m(a q ) with m(b), respectively. 
Moreover, let p'" — (pa, b) € B c p {p) and q'" = (qA, b) € B c p {q) denote the pro- 
jections of p and q on m(b). We show that the path composed of the segments 
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(p',p"), {p",p"'), {p"',q"'), {q"',q") and (q" 7 q') fulfills the requirements. See 
Fig. 6b. 

By Lemma 3.1 the intersection points p" and q" are inside B p (p) and B c p (q), 
respectively. Thus, by convexity of each ball the segments (p' \p") C m{q p ) 
and (q',q") C m(a q ) as well as the segments (p",p"'), (q",q'") C m(b) are in 
(BC(p)UBC(q)). 

It remains to show that (p"',q"') C m(b) is inside (B^(p) U B c p {q)). Recall 
that dist(p,q) < p and therefore dist(p"' ,q"') < p. Let p be a point on 
the segment (p"',q"') that, w.l.o.g, is closer to p'" . Thus dist(p,p"') < p/2. 
The manifold m(b) is p/\/2-intcrsecting, thus dist(p,p"') < p/V%. As the 
segments (p 7 p" r ) and (p'" ,p) are perpendicular it holds: 

dist(p,p) = ^dist{p,p'") 2 + dist(p"',p) 2 < y / p 2 /2 + p 2 /4 < p. 

a 

Theorem 3.3 Let p, q e Cf rec such that there exists a collision-free path 
lp,q € r of length L and clearance p between p and q. Then the probability 
of the MMS algorithm to return a path between p and q after generating ua 
and Ub manifolds from families M A and M B is: 

Pr[(p, g )SUCCESS] = 1 - Pr[(p, g )FAILURE] 



> 1 



where ha and \i B are some positive constants. 

Proof. Let I = \L/p~\, there exists a sequence [p ...pg] such that pi e 
Imilptq), Pa = P, Pi = q, B p (pi) e Cfrce and dist(pi,p i+1 ) < p. MMS adds 
the manifolds m{pA) and m(qA) to the connectivity graph. 

Let A' C A, \A'\ = ua and B' C B, \B'\ = ub, be the two point 
sets that define the manifolds M A and M B that are used by the MMS 
algorithm. If there is a subset {m{a\) . . . m(a^_i)} C M A and a subset 
{to(&i)...to(6^_i)} C M b ' such that (p l ,p. l+1 ,m{a l ),m(b l ),m(a i+1 )) ful- 
fill the conditions of Lemma 3.2 for i e {0 . . . £ — 1}, then there exists a path 
from p to g in the FSCs constructed by the MMS framework, namely the path 
which is the concatenation of paths constructed in Lemma 3.2. This implies 
that p and q are in the same connected component of Q 1 which implies that 
MMS constructs a path in Cf rcc from p to q. 

Let Ii . . . be a set of indicator variables such that each Jj witnesses the 
event that there is a p/-\/2-intersecting manifold for pi in M A . (For po and pe 
this is trivially the case due the explicit construction of m(p^) and m(g^).) 
Let Jo • • • Ji-\ be a set of indicator variables such that each Jj witnesses 
the event that there is a manifold in M B that is simultaneously p/\/2- 
intersecting for pi and Pi+i- It follows that MMS succeeds in answering the 
query (p, q) if h = 1 for all 1 < i < I - 1 and Jj = 1 for all < j < i - 1. 
Therefore, 
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Pr[(p, (z)FAILURE] < Pr (vtlih = 0) v£J (Jj = 0)) 



<^2Pr[I i =0]+^2Pr[J j =0]. 

i=l j=0 

The events ij = and = are independent since the samples are taken 
independent. Thus the probability Pr[Ii — 0], i.e., that not even one of the tia 
samples from A is p/v^-intersecting for p- L is (1 — pA) nA > where /i^ is the 
probability measure that a random sample a £ A defines a manifold that is 
/9/-\/2-intersecting f or a certain point peC. Thus, [ia is obviously positive. 
Similarly, Pr[Ji = 0] = (1 — /is)" B , where fig is the probability measure 
that a random sample b £ B defines a manifold that is p/v^-intersecting for 
a two specific points p,q e C with dist(p, q) < p, that is, it is proportional 
to the volume of the intersection B^^(p B ) n B^/^&b), which is positive 
since the radius of the balls is larger than p/2. Since the sampling is uniform 
and independent: 



Pr[(p, g)FAILURE] < 



< 



1 



(1-Ma)" a + 



(l-MB) r 



+(1-Mb)" b ]. 



□ 



It follows that as ua and tend to oo, the probability of failing to find a 
path under the conditions stated in Theorem 3.3 tends to zero. 



Recursive application The proof of Theorem 3.3 assumes that the 
samples are taken using full high-dimensional manifolds. However, Section 2 
demonstrates a recursive application of MMS where the approximate samples 
are generated by another application of MMS. 

In order to obtain a completeness proof for the two-level scheme let 7 be a 
path of clearance 2p. First, assume that the samples taken by the first level of 
MMS are exact. Applying Theorem 3.3 for 7 and p shows that with sufficient 
probability MMS would find a set M' of manifolds that would contain a path 
7'. Since we required clearance 2p but relied on the tighter clearance p, it 
is guaranteed that 7' still has clearance p. Now, each manifold to' € Ml is 
actually only an approximation constructed by another application of MMS. 
Thus, for each ml G Ml apply Theorem 3.3 to subpath j' m , = 7' (~l to' which 
has clearance p. Concatenation of all the resulting subpaths concludes the 
argument. Of course the parameters in the inequality in Theorem 3.3 change 
accordingly 

We remark that the recursive approach imposes a mild restriction on the 
sampling scheme as the sampling and the approximation must be somewhat 
coordinated. Since in theory m(a)r\m(b) = (a, b) we must ensure that points 
that we sample from A are contained in every approximation of m(b) € M B 
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and vise versa. In our implementation this is ensured by restricting the set of 
possible angles to those used to approximate m(b) £ Ai B (see Section 2). 

4 On the Dimension of Narrow Passages 

Consider the pacman scenario illustrated in Fig. 3c of the experiments section. 
We obtain a narrow passage by increasing the size of the square-shaped robot 
making it harder for the pacman to swallow it. Fig. 4 shows that our approach 
is significantly less sensitive to this tightening than the PRM algorithm. In 
order to explain this, let us take a closer look at the nature of the narrow 
passage for the tightest solvable case. 

In order to get from the start placement to 
the goal placement, the pacman must swallow the 
square, rotate around it and spit it out again. Due 
to symmetry it is sufficient to concentrate on the 
first part. The figure to the right depicts the tightest case, i.e., when the 
square robot fits exactly into the "mouth" of the pacman. The gray rect- 
angle indicates the positions of the reference point of the square such that 
there is a valid movement of the pacman that will allow it to swallow the 
square robot (two-dimensional region, two parameters) , the rotation angle of 
the square is also important (one additional parameter). The range of con- 
currently possible values for all three parameters is small but does not tend 
to zero. The passage becomes narrow by the fact that the rotation angle of 
the pacman must correlate exactly with the orientation of the square to allow 
for passing through the mouth. Moreover, the set of valid placements for the 
reference point of the pacman while swallowing the square (other parameters 
being fixed) is a line, i.e., its x and y parameter values are coupled. Thus, 
the passage is a four-dimensional object as we have a tight coupling of two 
pairs of parameters in a six-dimensional C-space. 

The PRM approach has difficulties to sample in this passage since the 
measure tends to zero as the size of the square increases. On the other hand, 
for our approach the passage is only tight with respect to the correlation of the 
two angles. As soon as the MMS samples an (approximated) volume that fixes 
the square robot such that the pacman can engulf it, the approximation of 
the volume just needs to include a horizontal slice of a suitable angle and the 
passage becomes evident in the corresponding Minkowski sum computation. 

4-1 Definition of Narrow Passages 

Intuition may suggest that narrow passages are tunnel-shaped. However, a 
one-dimensional tunnel in a high-dimensional C-spaces would correspond to 
a simultaneous coupling of all parameters, which is often not the case. For 
instance, the discussion of the pacman scenario shows that the passage is 
narrow but that it is still a four-dimensional volume, which proved to be a 
considerable advantage for our approach in the experiments. Though, some 
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sampling based approaches try to take the dimension of a passage into account 
(e.g. see [9]) it seems that this aspect is not reflected by existing definitions 
that attempt to capture attributes of the C-space. Definitions such as e- 
goodness [18] and expansiveness [f 6] are able to measure the size of a narrow 
passage better than the clearance [17] of a path, but neither incorporates the 
dimension of a narrow passage in a very accessible way. As a consequence, we 
would like to propose a new set of definitions that attempt to simultaneously 
grasp the tightness and the dimension of a passage. 

We start by defining the "ordinary" clearance of a path. The character- 
ization is based on the notion of homotopy classes of paths with respect 
to a set r Sit , i.e., the set of all paths starting at s and ending at t. For a 
path 70 <G r s , t and its homotopy class %(7o) we define the clearance of the 
class as the largest clearance found among all paths in "H(7o)- 

Definition 2. The clearance of a homotopy class H(jo) for 70 € r Syt is 
sup { sup{ p > I B d p Jm(7) C C frco } }, 

7£«(7o) 

where denotes the Minkowski sum of two sets, which is the vector sum of 
the sets. 

By using a d-dimensional ball this definition treats all directions equally, 
thus considering the passage of ^(70) to be a one-dimensional tunnel. We 
next refine this definition by using a fc-dimensional disk, which may be placed 
in different orientations depending on the position along the path. 

Definition 3. For some integer < k < d the fe-clearance of %(7o) is: 

sup { sup{ p > I 3R : [0, 1] -> K Vt e [0, 1] : -y(t) © R(t)B* C C frco } }, 
7 e«(7o) 

where 7Z is the set of (i-dimensional rotation matrices and B k p is the k- 
dimensional ball of radius p. In case the map R is required to be continuous 
we talk about continuous fe-clearance. 

Clearly, the fc-clearance of H(jo) for k = d is simply the clearance of H(jq). 
For decreasing values of k, the fc-clearance of a homotopy class is a monotonic 
increasing sequence. We next define the dimension of a passage using this 
sequence, that is, we set the dimension to be the first k for which the clearance 
becomes significantly larger 8 than the original c?-dimcnsional clearance. 

Definition 4. A passage for ^(70) in R d of clearance p is called fe-dimensional 

if k is the largest index such that fc-clearance (^(70)) 3> P- If for every k k- 
clearance("H(7o)) ^> p then the passage is termed one-dimensional. 



We leave this notion informal as it might depend on the problem at hand. 



MMS in High-Dimensional Configuration Spaces 



15 




The figure on the right illustrates two 
three-dimensional C-spaces consisting of 
a narrow passage (yellow) surrounded by 
obstacles (blue). Both passages have a 
measure of e 2 thus for a PRM like planner, 
sampling in either passage is equally hard 
as the probability of a uniform point sample to lie in either one of the narrow 
passages is proportional to e 2 . However, the two passages are fundamentally 
different. The passage depicted on the right-hand side is a one-dimensional 
tunnel corresponding to a tight coupling of the three parameters. The pas- 
sage depicted on the left-hand side is a two-dimensional flume which is much 
easier to intersect by a probabilistic approach that uses manifolds as samples. 
Our new definitions formally reveal this difference. For k equals 3, 2 and 1 
the ^-clearance of the right passage is e, y/2e and larger than 1, respectively. 
For the left passage this sequence is e 2 for k — 3 and larger than 1 for k = 2, 1 
which characterizes the passage as two-dimensional. 

4-2 Discussion 

We believe that the definitions introduced in Section 4.1, can be an essential 
cornerstone for a formal proof that shows the advantage of manifold samples 
over point samples in the presents of high-dimensional narrow passages. We 
sketch the argument briefly. Let Cf roo contain a narrow passage of dimension k, 
that is, the passage has clearance p and fc-clearance A, where A 3> p. This 
implies that it is possible to place discs of dimension k and radius A ^> p into 
the tight passage. The main argument is that for a random linear manifold of 
dimension d — k the probability to hit such a disc is proportional to A, which 
is much larger than p. The probability also depends on the angle between 
the linear subspace containing the disc and the linear manifold. However, by 
choosing a proper set of manifold families it should be possible to guarantee 
the existence of at least one family for which the angle is bounded. 



5 Further Work 



The extension of MMS [29] presented here is part of our on-going efforts to- 
wards the goal of creating a general scheme for exploring high-dimensional 
C-spaces that is less sensitive to narrow passages than currently available 
tools. As discussed in Section 1.3 the original scheme imposes a set of con- 
ditions that in combination restrict an application of MMS to rather low 
dimensions. In this paper we chose to relax condition C3, namely by com- 
puting only approximations of three-dimensional manifolds. An alternative 
path is to relax condition C2, namely by not sampling the manifolds uni- 
formly and independently at random. This would enable the use of manifolds 
of low dimension as it allows to enforce intersection. Following this path we 
envision a single-query planer that explores a C-space in an RRT-like fashion. 
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Another possibility is to explore other ways to compute approximative 
manifold samples, for instance, the (so far) exact representations of FSCs 
could be replaced by much simpler (and thus faster) but conservative 9 ap- 
proximations. This is certainly applicable to manifold samples of dimension 
one or two and should also enable manifold samples of higher dimensions. 
We remark that the use of approximations should not harm the probabilistic 
completeness as long as it is possible to refine approximations such that they 
converge to the exact results (equivalent to increased number of samples). 

Using these extensions we wish to apply the scheme to a variety of dim- 
cult problems including assembly maintainability (part removal for mainte- 
nance [37]) by employing a single-query variant of the scheme. Additionally, 
we intend to extend the scheme to and experiment with motion-planning 
problems for highly-redundant robots as well as for fleets of robots, exploit- 
ing the symmetries in the respective C-space. 

For supplementary material, omitted here for lack of space, the reader is 
referred to our web-page http://acg.cs.tau.ac.il/projects/mms. 
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Appendix — Critical Values for Rotating Robot 

We consider a polygonal robot rotating about a fixed reference point amidst 
polygonal obstacles. As the position of the robot is fixed the considered mani- 
fold is a vertical line in the configuration space whose endpoints are identified. 
Thus we parameterize the manifold with r € P(K). On this manifold we are 
interested in the FSCs, which are bounded by critical values. A critical value 
indicates a potential transition between Cf ree and Cf or b, i-e., a configuration 
where the robot is in contact with an obstacles. More precisely: Either a 
robot's edge is in contact with an obstacle's vertex or a robot's vertex is in 
contact with an obstacle's edge. These cases will be referred to as vertex- 
edge contacts and edge-vertex contacts, respectively. The rest of this section 
introduces the necessary notions to analyze the problem. 

A robot R is a simple polygon with vertices {v\, . . . ,v n } where Vi = 
Ui) T and edges {(i>i, V2), • • • (v n , We assume that the reference point 
of R is located at the origin. The position of R in the workspace is defined by 
a configuration q = (r q ,6 q ) where r q = (x q ,y q ) T . Thus, q maps the position 
of a vertex Vi as follows: 

Vi(q) = M{6 q )vi + r q , where M(9) = 

is the rotation matrix. Given a fixed point p = (x p ,y p ) T we define in Equa- 
tion 1 the parameterization (p, r) e M 2 xlP 1 which fixes the robot's reference 
point to a specific location. 

x q = x p Vq — Up 8q = 2arctanT. (1) 
A parameterized vertex is represented in Equation (2) 

Vi(p,T)=M(T)Vi+p, (2) 

where M(r) = 
Robot's vertex - Obstacle's edge 

Let r q — (x q ,y q ) T be the robot's fixed location. Let Vi be a robot's vertex 
and v Qj where j € 1,2 be the obstacle's edge's endpoints. The obstacle's 
edge can be parameterized as e a (s) = v \ + s(v o2 — v i) where s e [0,1]. 
If the distance between the fixed reference point and the obstacle's edge is 
larger than the distance between the robot's vertex and its reference point, 
then the edge cannot impose a constraint. Namely all the edges e such that 
d(r q , e) > d(r q , Vi) may be filtered out. A criticality occurs when the robot's 
vertex coincides with the edge e, thus e(s) = Vi(r q ,r) This yields the following 
equalities: 



cos 6 — sin 6 
sin 9 cos 9 



1-T 2 -2r 
2r 1 - r 2 
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( - ^ - 1 ~ T " 2TVi ■ 

1 + T £ 1 + T z 

2r 1-t 2 

Vol + S{y o2 -Vol)= 1 + T 2 X i + 1 + T 2 Vi + % 

Thus: 

(1 + t 2 )x o1 + s(l + r 2 )(a; 2 - z i) = (1 - t 2 ).t, - (2r)y, + ar 9 (l + t 2 ) 
(1 + r 2 )y ol + s(l + r 2 )(y o2 - y ol ) = (2t).t, + (1 - r 2 )y 4 + y q (l + r 2 ) 

Or, 

s(l+T 2 )(x o2 -x ol )(y o2 -y ol ) = [(l-T 2 )x, l -(2T)y, l +(l+T 2 )(x q -x ol )](y o2 -y ol ) 

s(l+T 2 )(x o2 -x ol )(y o2 -y ol ) = [(2r)xi + (l-T 2 )?/ 4 +(l+T 2 )(?yg-y i)](a; 2-a; i) 
denoting A ox = x o2 - x ol , and A oy = y o2 - y ol : 

[{l-T 2 )x l -(2T)y t +^+r 2 )(x q ^x ol )}A oy = [(2r) a ; J +(l-r 2 )y l +(l+r 2 )(y 9 -y ol )]A 
Finally: 

k 2 r 2 + kir + k = (3) 

Where: 

h = (x q - x ol - Xi)A oy - (y q - y ol - yi)A ox 

fci = -2(yiAoy + XiA ox ) 

h) = {x q - x i + Xi)A oy - (y q - y ol + yi)A ox 

^ox — *^o2 *^ol ) 

A oy = y o2 - y i 

The solutions to Equation 3 are two parameterized angles t\,t 2 . These critical 
values represent potential transitions between Cf roc and Cf or b- The parame- 
terized angles may represent intersections that are not on the obstacle's edge 
but on the line supporting the obstacle's edge. Namely if we obtain s\,s 2 by 
plugging ti,t 2 to one of the two following equations and Sj ^ [0, 1] then we 
should not consider the corresponding Tj. 

(1 - T 2 ) Xl - (2T) Vi + (1 + T 2 )( Xq - X ol ) 
Oo2 ~ X ol )(l + T 2 ) 

= (2T)x l + (l-T 2 )y l + {l + T 2 )(y q -y ol ) 

(y o2 -y i)(i + T 2 ) 
Robot's edge - Obstacle's vertex 

Let r q = (x q ,y q ) T be the fixed robot's location. Let Vi,v 2 be the robot's ver- 
tex such that the robot's edge is defined as e(s, r qi r) = v\(r q , T)+s(v 2 (r q , r) — 
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Vi(r q , t)) for s e [0, 1] and v be the obstacle's vertex. If the distance between 
the fixed reference point and the obstacle's vertex is larger than the distance 
between the robot's two vertices and its reference point, then the vertex 
cannot impose a constraint. Namely all the obstacle vertices v such that 
d(r q ,vo) > d(r q ,Vi) may be filtered out. A criticality occurs when a point 
on the robot's edge coincides with the obstacle's vertex, namely for some 
se [0,1]: 

Vox = v lx (p, t) + s(v 2x (p, t) - v lx (p, t)) 



v oy = v ly (p,T) + s(v 2v (p,t) - v ly (p,r)) 

Thus, 

(vox - v lx (p, T))(v 2 y(p, t) - v ly (p, t)) = (v oy - v ly (p, t))(v 2x {p, t) - v lx (p, r)) 
Denoting A x = v 2x — v\ x and A y = v 2y — v\ y : 

{vox - v lx (p, t))(2tA x + (1 - T 2 )A y ) = (v oy - v ly {p, t))((1 - t 2 )A x - 2tA v ) 
Let us denote a — {v ox — x q ) and b — (v oy — y q ) and k = v\ x v 2y — v 2x V\ y : 
[aA y - bA x + k]r 2 - 2[aA x + bA y ]r + [-aA y + bA x + k] = 



1 2 t 2 +l lT + l =0 (4) 

Where: 

A x = v 2x - v lx , 

l 2 = aA y - bA x + k A y = v 2y - vi y , 

h = -2(aA x + bA y ) a=(v ox -x q ), 
l = -l 2 + 2k b= (v oy - y q ), 

k = vi x v 2y - v 2x vi y 

Similarly to the case of a robot's vertex in contact with an obstacles edger, 
the solutions to Equation 4 arc two parameterized angles n , t 2 that repre- 
sent potential transitions between Cf roo and Cf or b- Again, these angles may 
represent intersections that are not on the robot's edge but on the line sup- 
porting the edge. Namely if we obtain Si,s 2 by plugging t\,t 2 to one of 
the two following equations and ^ [0, 1] then we should not consider the 
corresponding Tj. 

Vox - V lx (p,T) 

g ^ 

V2x(p,t) - v lx (p,r) 

= Voy - Vly(p,T) 

v 2y (p,T) - v ly (p,r) 



